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(57) 摘 要 


本 申请 提供 了 一 种 运载 火箭 组 合 导航 功能 
验证 系统 及 验证 方法 ,验证 系统 包括 卫星 导航 接 
收 机 ,设置 在 运载 工具 上 ,其 用 于 接收 卫星 信号 ， 
并 计算 得 到 卫星 导航 接收 机 当前 的 位 置 和 速度 
数据 ;惯性 测量 组 合 , 设 置 在 运载 工具 内 ,其 用 于 
获取 运载 工具 的 惯性 测量 数据 ; 飞 控 计算 机 , 设 
置 在 运载 工具 内 ,其 用 于 根据 卫星 导航 接收 机 当 
前 的 位 置 和 速度 数据 以 及 惯性 测量 数据 计算 得 | 
到 实验 数据 ;仿真 下 位 机 和 仿真 上 位 机 均 设 置 在 

运载 工具 内 ,仿真 下 位 机 与 飞 控 计 算 机 进行 信息 

交互 ,仿真 下 位 机 与 仿真 上 位 机 进行 信息 交互 。 
二 本 申请 能 够 实现 对 火箭 导航 软 硬 件 全 系统 和 全 
流程 的 验证 ,减少 人 力 成 本 ,加 快 火箭 研发 的 进 
度 ,并 确保 最 终 飞 行 产 品 的 可 靠 性 。 
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1. 一 种 运载 火 第 组 合 导 航 功 能 验证 系统 ,其 特征 在 于 ,包括 卫星 导航 接收 机 、 惯 性 测量 
组 合 、 飞 控 计 算 机 、 仿 真 下 位 机 、 仿 真 上 位 机 和 运载 工具 ; 

所 述 卫星 导航 接收 机 设置 在 所 述 运 载 工 具 上 ,其 用 于 接收 卫星 信号 ,并 根据 卫星 信号 
得 到 所 述 卫 星 导 航 接收 机 当前 的 位 置 和 速度 数据 ; 

所 述 惯性 测量 组 合 设置 在 所 述 运载 工具 内 ,其 用 于 获取 所 述 运载 工具 的 惯性 测量 交 


据 ; 


所 述 飞 控 计算 机 设置 在 所 述 运 载 工 具 内 ,其 与 所 述 卫星 导航 接收 机 和 惯性 测量 组 合 连 
接 , 用 于 根据 所 述 卫星 导航 接收 机 当前 的 位 置 和 速度 数据 以 及 惯性 测量 数据 计算 得 到 实验 
数据 ; 

所 述 仿真 下 位 机 和 仿真 上 位 机 均 设 置 在 所 述 运 载 工具 内 ,所 述 仿真 下 位 机 与 飞 控 计算 
机 连接 ,其 用 于 启动 所 述 飞 控 计 算 机 ,并 从 所 述 飞 控 计算 机 处 获取 实验 数据 ; 

所 述 仿真 上 位 机 与 仿真 下 位 机 连接 ,其 用 于 提供 人 机 交互 界面 ,控制 所 述 仿真 下 位 机 
的 启 停 ,并 从 所 述 仿真 下 位 机 处 获取 实验 数据 。 

2. 根 据 权 利 要 求 1 所 述 的 运载 火箭 组 合 导 航 功 能 验证 系统 ,其 特征 在 于 ,还 包括 螺 寻 北 
仪 和 电子 经 纬 仪 ; 

所 述 陀 螺 寻 北 仪 用 于 确定 北向 方位 ,所 述 电子 经 纬 仪 用 于 测量 所 述 陀 螺 寻 北 仪 和 惯性 
测量 组 合 间 瞄准 路 线 的 多 个 角度 ;所 述 电子 经 纬 仪 根据 北 同方 位 角 和 瞄准 路 线 的 多 个 角度 
te 
控 计 算 机 中 。 

3. 根 据 权 利 要 求 1 或 2 所 述 的 运载 火箭 组 合 导 航 功 能 验证 系统 ,其 特征 在 于 ,还 包括 市 
电 以 及 与 市 电 连 接 的 AD/DC 转 换 器 ; 

所 述 市 电 用 于 给 所 述 仿真 下 位 机 和 仿真 上 位 机 供电 ,所 述 AD/DC 转 换 器 与 所 述 飞 控 计 
算 机 和 惯性 测量 组 合 电 连接 。 

4. 根 据 权 利 要 求 1 或 2 所 述 的 运载 火箭 组 合 导航 功能 验证 系统 ,其 特征 在 于 ,还 包括 耦 
合 器 ,所 述 仿真 下 位 机 、 飞 控 计 算 机 和 惯性 测量 组 合 均 通 过 1553B 线 缆 连 接 在 所 述 耦 合 器 
下 二 


半 


广 


5. 根 据 权 利 要 求 1 或 2 所 述 的 运载 火箭 组 合 导航 功能 验证 系统 ,其 特征 在 于 ,所 述 惯性 
量 数据 包括 陀螺 仪 和 加 速度 计 的 脉冲 数 输出 。 
6. 根 据 权 利 要 求 1 或 2 所 述 的 运载 火箭 组 合 导 航 功 能 验证 系统 ,其 特征 在 于 ,所 述 卫 星 
导航 接收 机 包括 接收 机 天 线 和 接收 机 板 卡 , 所 述 接收 机 天 线 设置 在 所 述 运载 工具 的 顶部 ， 
所 述 接收 机 板 卡 设 置 在 所 述 运载 工具 内 ,所 述 接收 机 天 线 与 接收 机 板 卡 连 接 ; 所 述 接收 机 
板 卡 根据 卫星 信号 计算 得 到 卫星 导航 接收 机 的 位 置 和 速度 信息 ,并 发 送 给 所 述 飞 控 计 算 
机 。 


师 


疯 


7. 根 据 权利 要 求 1 或 2 所 述 的 运载 火 第 组 合 导 航 功 能 验证 系统 ,其 特征 在 于 ,所 述 飞 控 
计算 机 中 设置 有 射 前 流程 模块 、 惯 性 导航 模块 和 组 合 导航 模块 ; 

所 述 射 前 流程 模块 根据 接收 到 的 初始 方位 角 和 惯性 测量 数据 计算 补偿 后 的 方位 角 和 
惯性 测量 组 合 的 水 平 姿态 角 , 并 利用 计算 得 到 的 补偿 后 的 方位 角 和 惯性 测量 组 合 的 水 平 姿 
态 角 对 所 述 惯性 导航 模块 进行 初始 化 ， 

所 述 惯 性 导航 模块 根据 接收 到 的 惯性 测量 组 合 提供 的 惯性 测量 数据 完成 惯性 导航 计 
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算 ,得 到 发 射 惯性 坐标 系 下 运载 工具 的 速度 和 位 置 ; 

所 述 组 合 导航 模块 根据 接收 到 的 惯性 导航 模块 提供 的 位 置 和 速度 信息 以 及 卫星 导航 
接收 机 提供 的 位 置 和 速度 信息 进行 组 合 导航 计算 ,得 到 组 合 导航 的 位 置 和 速度 输出 值 。 

8. 根 据 权 利 要 求 7 所 述 的 运载 火箭 组 合 导航 功能 验证 系统 ,其 特征 在 于 ,所 述 惯性 导航 
模块 进行 惯性 导航 计算 的 具体 过 程 为 : 

利用 惯性 测量 组 合 中 的 陀螺 仪 和 加 速度 计 的 脉冲 数 输出 ,通过 提取 增 量 信息 并 进行 系 
数 转换 ,计算 得 到 运载 工具 运动 的 角度 增 量 和 视 速 度 增 量 ; 

利用 运载 工具 运动 的 角度 增 量 进行 四 元 数 更 新 计算 ,并 利用 更 新 后 的 四 元 数 计算 惯 2 
测量 坐标 系 到 发 射 惯性 坐标 系 的 旋转 和 矩阵; 
其 中 ,更 新 的 四 元 数 初 值 由 射 前 流程 结束 时 刻 惯 组 测量 坐标 系 和 发 射 坐标 系 的 旋转 甜 
阵 所 确定 ; 

利用 惯 组 测量 坐标 系 到 发 射 惯性 坐标 系 的 旋转 矩阵 ,将 惯 组 测量 坐标 系 下 的 视 速 度 增 
量 转 换 至 发 射 惯性 坐标 系 下 ,得 到 发 射 惯性 坐标 系 下 的 视 速 度 增 量 ; 

根据 发 射 惯性 坐标 系 下 的 视 速 度 增 量 ,结合 当前 位 置 的 引力 矢量 进行 一 个 导航 周期 内 
的 一 次 积分 和 两 次 积分 ,分 别 得 到 发 射 惯性 坐标 系 下 运载 工具 的 速度 和 位 置 。 

9. 根 据 权 利 要 求 7 所 述 的 运载 火箭 组 合 导航 功能 验证 系统 ,其 特征 在 于 ,所 述 组合 导 航 
模块 进行 组 合 导航 计算 的 过 程 为 : 

将 运载 工具 的 位 置 与 位 置 真实 值 的 误差 的 估计 值 以 及 速度 与 速度 真实 值 的 误差 的 估 
计 什 作为 状态 量 ;将 卫星 导航 接收 机 的 位 置 与 通过 惯性 导航 计算 得 到 的 运载 工具 的 位 置 丰 
实 值 的 误差 的 估计 值 ,以 及 卫星 导航 接收 机 的 速度 与 通过 惯性 导航 计算 得 到 的 运载 工具 的 
速度 真实 值 的 误差 的 估计 值 作为 观测 量 ; 

给 定 状 态 量 的 初 值 、 误 差 方差 阵 的 初 值 和 系统 噪声 方差 阵 的 初 值 ,以 及 量 测 噪声 方差 
阵 和 观测 和 矩阵; 

根据 当前 导航 周期 惯性 导航 解 算 的 旋转 矩阵 、 位 置 和 视 加 速度 信息 构造 当前 导航 周期 
的 状态 转移 矩阵 和 噪声 分 配 阵 ;其 中 ,利用 状态 转移 矩阵 构造 出 当前 导航 周期 一 步 状态 转 
移 窍 阵 ;使 用 状态 转移 矩阵 、 噪 声 分 配 阵 和 系统 噪声 方差 阵 初 值 计 算得 到 当前 导航 周期 的 
系统 噪声 方差 阵 ; 

根据 计算 和 给 定 的 量 测 噪声 方差 阵 、 观 测 和 矩阵 、 旋 转 和 矩阵 ,状态 转移 矩阵 、 品 声 分 配 阵 
和 系统 噪声 方差 阵 以 及 状态 量 和 观测 量 ,利用 卡尔 曼 滤 波 公 式 进行 状态 量 的 估计 和 修正 计 
算 ; 

利用 当前 导航 周期 的 状态 量 的 估计 值 中 的 位 置 误差 对 惯性 导航 位 置 进行 修正 ,利用 当 
前 导航 周期 的 状态 量 的 估计 值 中 的 速度 误差 对 惯性 导航 速度 进行 修正 ,得 到 组 合 导航 的 位 
置 和 速度 输出 值 。 

10 .一 种 运载 火箭 组 合 导航 功能 验证 方法 ,其 特征 在 于 ,包括 以 下 步骤 : 

使 运载 工具 和 惯性 测量 组 合 保持 静止 ,获取 惯性 测量 组 合 的 初始 方位 和 角 ,并 发 送 给 飞 
控 计 算 机 ; 

惯性 测量 组 合 获取 运载 工具 的 惯性 测量 数据 并 发 送 给 飞 控 计 算 机 ; 

飞 控 计算 机 中 的 射 前 流程 模块 根据 惯性 测量 组 合 的 初始 方位 角 和 运载 工具 的 惯性 测 
量 数据 计算 补偿 后 的 方位 角 和 惯性 测量 组 合 的 水 平 姿态 角 , 并 利用 补偿 后 的 方位 角 和 惯性 
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量 组 合 的 水 平 姿态 角 对 飞 控 计 算 机 中 的 惯性 导航 模块 进行 初始 化 ; 
初始 化 后 的 惯性 导航 模块 利用 惯性 测量 数据 进行 惯性 导航 计算 ,得 到 惯性 导航 位 置 和 
速度 信息 ; 

卫星 导航 接收 机 将 其 当前 的 位 置 和 速度 信息 发 送 给 飞 控 计算 机 ; 

飞 控 计算 机 中 的 组 合 导 航模 块 利用 卫星 导航 接收 机 当前 的 位 置 和 速度 信息 以 及 惯性 
导航 位 置 和 速度 信息 进行 组 合 导航 计算 ,得 到 修正 后 的 位 置 和 速度 信息 ，; 

局 动 运载 工具 ,并 沿 预定 路 线 行驶 , 飞 控 计算 机 在 运载 工具 行驶 的 过 程 中 , 进行 全 程 惯 
性 导航 和 组 合 导航 计算 ,得 到 实验 数据 ; 

飞 控 计算 机 通过 仿真 下 位 机 将 得 到 的 实验 数据 发 送 给 仿真 上 位 机 进行 存储 。 

11 .根据 权利 要 求 10 所 述 的 运载 火箭 组 合 导航 功能 验证 方法 ,其 特征 在 于 ,获取 惯性 测 
量 组 合 的 初始 方位 角 时 ,根据 北向 方位 和 由 电子 经 纬 仪 所 传递 的 瞄准 路 线 的 多 个 角度 得 到 
惯性 测量 组 合 的 初始 方位 角 ; 

所 述 北 向 方位 由 设置 在 地 面 上 的 陀螺 寻 北 仪 得 到 ,瞄准 路 线 的 多 个 角度 由 设置 在 地 面 
上 的 电子 经 纬 仪 得 到 。 

12 .根据 权 利 要 求 10 所 述 的 运载 火箭 组 合 导 航 功能 验证 方法 ,其 特征 在 于 ,获取 惯性 测 
量 组 合 的 初始 方位 角 时 ,根据 地 球 重力 加 速度 和 地 球 转角 速度 得 到 惯性 测量 组 合 的 初始 方 
位 角 ; 

所 述 地 球 重 力 加 速度 和 地 球 转角 速度 由 惯性 测量 组 合 测量 得 到 。 


师 
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运载 火箭 组 合 导航 功能 验证 系统 及 验证 方法 
技术 领域 


[0001] “本 申请 属于 运载 火箭 导航 技术 领域 ,具体 涉及 一 种 运载 火箭 组 合 导航 功能 验证 系 
统 及 验证 方法 。 


背景 技术 

[0002] ”在 运载 火箭 导航 系统 的 研制 过 程 中 ,判断 导航 系统 的 软 硬 件 功 能 实现 是 否 满足 要 
求 , 需 要 对 最 终 的 飞行 产品 进行 仿真 实验 验证 。 目 前 运载 火箭 及 其 它 运 载体 的 惯性 /GNSS 
(全 球 卫星 导航 系统 ) 组 合 导 航 系统 仿真 实验 通常 有 下 几 种 方式 : 

[0003] ”1) 在 仿真 计算 机 中 使 用 软件 生成 一 条 运动 轨迹 ,将 该 轨迹 的 位 置 .速度 作为 卫星 
接收 机 所 得 的 运动 信息 直接 传输 给 飞 控 计算 机 与 此 同时 ,仿真 计算 机 中 的 惯性 测量 组 合 
的 数学 模型 产生 与 运动 轨迹 、 速 度 相 应 的 惯 组 信号 传输 给 飞 控 计算 机 , 飞 控 计算 机 使 用 这 
些 信息 完成 惯性 导航 和 组 合 导航 的 计算 。 

[0004] ”这 种 实验 方案 使 用 的 硬件 设备 很 少 ,惯性 导航 和 组 合 导航 信息 源 都 使 用 数学 模型 
计算 的 结果 ,能够 较 快 地 实现 对 惯性 导航 和 组 合 导航 模块 的 验证 。 但 是 这 种 方案 由 于 大 量 
使 用 数学 模型 ,因此 未 能 验证 真实 的 惯 组 、 接 收 机 参与 下 的 整个 导航 系统 的 功能 ;同时 对 于 
惯 组 的 射 前 初始 瞄准 方案 需要 另外 验证 ,无 法 参与 到 导航 系统 的 仿真 实验 中 ,因此 存在 二 
者 不 匹配 的 风险 。 

[0005] ”2) 在 仿真 计算 机 中 使 用 软件 生成 一 条 运动 轨迹 ,将 该 轨迹 的 位 置 .速度 信号 发 送 
给 卫星 模拟 器 ， 卫星 模拟 器 产生 卫星 信号 并 发 送 给 接收 机 ， 由 接收 机 板 卡 接收 和 计算 得 到 
位 置 和 速度 后 传送 给 飞 控 计算 机 ;与 此 同时 , 惯 组 信号 仍 由 惯 组 数学 模型 产生 , 飞 控 计 算 机 
使 用 这 些 信息 完成 惯性 导航 和 组 合 导航 的 计算 。 

[0006] ”这 种 方案 能 够 将 接收 机 带 入 导航 系统 中 进行 运行 与 验证 ,增加 了 参与 验证 的 设 
备 ,但 这 个 方案 与 上 一 方案 相 比 增加 了 卫星 模拟 器 ,提高 了 成 本 ;同时 本 方案 同样 未 将 真实 
惯 组 接 入 回路 中 ,无 法 对 真实 惯 组 与 飞 控 计算 机 、 惯 性 导航 模块 的 匹配 性 进行 验证 ;同样 无 
法 将 初始 瞄准 方案 与 整个 导航 系统 进行 联合 验证 。 
[0007] ”3) 在 仿真 计算 机 中 使 用 软件 生成 一 条 运动 轨迹 ,由 卫星 模拟 器 给 出 模拟 的 卫星 信 
号 ,由 接收 机 板 卡 接收 和 计算 后 得 到 卫星 导航 的 位 置 和 速度 ; 惯 组 安装 在 转台 上 ,通过 转台 
的 旋转 模拟 运动 姿态 的 变化 得 到 陀螺 仪 的 信号 ,加 速度 计 的 输出 仍然 通过 数学 模型 获得 ， 
最 终 飞 控 计算 机 使 用 这 些 信息 完成 惯性 导航 和 组 合 导航 的 计算 。 

[0008] ”这 种 方案 相 比 上 一 种 方案 实现 了 对 惯 组 中 的 陀螺 仪 部 分 的 实物 模拟 ,同时 可 以 将 
初始 瞄准 方案 与 整个 导航 系统 进行 联合 验证 ,很 大 程度 上 还 原 了 火箭 或 其 它 运载 体 真实 运 
动情 况 下 导航 系统 的 运作 ,但 这 种 方式 所 需要 的 设备 较 多 ,成 本 较 高 ,并且 未 能 对 真实 加 速 
度 计 进行 仿真 验证 。 
[0009] ” 少 在 仿真 计算 机 中 使 用 软件 生成 一 条 运动 轨迹 ,由 卫星 模拟 器 和 接收 机 板 卡 得 到 
卫星 导航 的 位 置 和 速度 ;使 用 转台 模拟 陀螺 仪 的 运动 规律 ,得 到 陀螺 仪 的 输出 :使 用 离心 机 
模拟 加 速度 计 的 运动 规律 ,得 到 加 速度 计 的 输出 ,最 终 飞 控 计 算 机 使 用 这 些 信 息 完 成 惯性 


Ed 
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导航 和 组 合 导 航 的 计算 。 

[0010] ”这 种 方案 能 够 真实 还 原 导航 系统 所 有 和 软 硬件 的 工作 状态 ,实现 包括 初始 瞄准 在 内 
的 完整 的 组 合 导航 系统 验证 ,但 是 这 种 方案 所 需 的 外 部 设备 很 多 ,操作 复杂 ,成 本 高 ,存在 


较 大 兽 端 。 


[0011] ” 综 上 所 述 ,在 传统 的 导航 系统 仿真 实验 中 ,通常 需要 在 实验 室 用 数学 模型 或 转台 、 


离心 机 来 模拟 惯 组 的 输出 ,用 卫星 模拟 器 模拟 卫星 信号 ,另外 单独 进行 射 前 瞄准 实验 ,使 得 


全 套 仿真 设备 过 于 复杂 ,增加 了 人 力 和 设备 成 本 ,同时 也 带 来 了 多 个 设备 同时 模拟 运动 参 


数 导 致 的 模拟 效果 不 协调 和 不 真实 的 问题 , 且 通 常 无 法 进行 完整 的 导航 系统 验证 实验 ,给 


最 终 的 飞行 产品 留 下 隐患 。 因 此 ,所 属 领 域 技 术 人 员 咪 需 研 发 一 种 运载 火箭 组 合 导航 功能 
验证 系统 及 验证 方法 ,在 验证 真实 的 惯 组 .接收 机 参与 下 的 整个 导航 系统 功能 的 同时 ,将 初 


台 瞄 准 方案 


发 明 内 容 


与 整个 导航 系统 进行 联合 验证 ,并 降低 整个 方案 的 实验 成 本 。 


[0012] ”为 至 少 在 一 定 程度 上 克服 相关 技术 中 存在 的 问题 ,本 申请 提供 了 一 种 运载 火箭 组 


合 导 航 功 能 验证 系统 及 验证 方法 。 


[0013] ”根据 本 申请 实施 例 的 第 一 方面 ,本 申请 提供 了 一 种 运载 火箭 组 合 导航 功能 验证 系 
统 ,其 包括 卫星 导航 接收 机 、 惯 性 测量 组 合 、 飞 控 计算 机 、 仿 真 下 位 机 、 仿 真 上 位 机 和 运载 工 


具 ; 
[0014] 所 
信号 得 到 所 
[0015] 所 
数据 ; 
[0016] 所 


述 飞 控 计 算 机 设置 在 所 述 运 载 工具 内 ,其 与 所 述 卫 星 导 航 接收 机 和 惯性 测量 组 


述 卫星 导航 接收 机 设置 在 所 述 运 载 工 具 上 ,其 用 于 接收 卫星 信号 ,并 根据 卫星 
述 卫星 导航 接收 机 当前 的 位 置 和 速度 数据 ; 
述 惯性 测量 组 合 设 置 在 所 述 运 载 工 具 内 ,其 用 于 获取 所 述 运 载 工 具 的 惯性 测量 


合 连 接 ,用 于 根据 所 述 卫星 导航 接收 机 当前 的 位 置 和 速度 数据 以 及 惯性 测量 数据 计算 得 到 


实验 数据 ; 
[0017] 所 


[0018] 所 


[0019] 上 
[0020] 所 
惯性 测量 组 合 
角度 胡 


师 


济 


[0021] 上 
换 器 ，; 
[0022] 所 


[0023] 上 上 


述 仿真 下 位 机 和 仿真 上 位 机 均 设 置 在 所 述 运 载 工 具 内 ,所 述 仿 真 下 位 机 与 飞 控 
计算 机 连接 ， 
述 仿 真 上 位 机 与 仿真 下 位 机 连接 ,其 用 于 提供 人 机 交互 界面 ,控制 所 述 仿真 下 
位 机 的 启 停 ， 
述 运 载 火 箭 组 合 导航 功能 验证 系统 中 ,还 包括 螺 寻 北 仪 和 电子 经 纬 仪 ; 


其 用 于 启动 所 述 飞 控 计算 机 ,并 从 所 述 飞 控 计算 机 处 获取 实验 数据 ; 


并 从 所 述 仿真 下 位 机 处 获取 实验 数据 。 


述 陀螺 寻 北 仪 用 于 确定 北向 方位 ,所 述 电子 经 纬 仪 用 于 测量 所 述 陀 螺 寻 北 仪 和 


间 瞄 准 路 线 的 多 个 角度 ;所 述 电 子 经 纬 仪 根据 北向 方位 角 和 瞄准 路 线 的 多 个 


定 所 述 惯性 测量 组 合 的 初始 方位 角 , 并 将 所 述 惯 性 测量 组 合 的 初始 方位 角 写 入 到 所 
述 飞 控 计算 机 中 。 
述 运载 火箭 组 合 时 航 功能 验证 系统 中 ,还 包括 市 电 以 及 与 市 电 连 接 的 AD/DC 转 


述 市 电 用 于 给 所 述 仿真 下 位 机 和 仿真 上 位 机 供电 ,所 述 AD/DC 转 换 器 与 所 述 飞 
控 计 算 机 和 | 


积 性 测量 组 合 电 连接 。 


述 运载 火箭 组 合 导航 功能 验证 系统 中 ,还 包括 耦合 器 ,所 述 仿真 下 位 机 、 飞 控 计 
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算 机 和 惯性 测量 组 合 均 通过 1553B 线 缆 连 接 在 所 述 耦 合 器 上 。 

[0024] ”上述 运载 火箭 组 合 导航 功能 验证 系统 中 ,所 述 惯性 测量 数据 包括 陀螺 仪 和 加 速度 
计 的 脉冲 数 输 出 。 
[0025] ”上述 运 载 火 箭 组 合 导航 功能 验证 系统 中 ,所 述 卫星 导航 接收 机 包括 接收 机 天 线 和 
接收 机 板 卡 ,所 述 接收 机 天 线 设置 在 所 述 运载 工具 的 顶部 ,所 述 接收 机 板 卡 设置 在 所 述 运 
载 工具 内 ,所 述 接收 机 天 线 与 接收 机 板 卡 连接 ;所 述 接收 机 板 卡 根据 卫星 信号 计算 得 到 卫 
星 导 航 接收 机 的 位 置 和 速度 信息 ,并 发 送 给 所 述 飞 探 计算 机 。 

[0026] ”上述 运 载 火 箭 组 合 导航 功能 验证 系统 中 ,所 述 飞 控 计 算 机 中 设置 有 射 前 流程 模 
块 、 惯 性 导航 模块 和 组 合 导航 模块 

[0027] ”所 述 射 前 流程 模块 根据 接收 到 的 初始 方位 角 和 惯性 测量 数据 计算 补偿 后 的 方位 
角 和 惯性 测量 组 合 的 水 平 姿态 角 , 并 利用 计算 得 到 的 补偿 后 的 方位 角 和 惯性 测量 组 合 的 水 
平 姿态 角 对 所 述 惯 性 导航 模块 进行 初始 化 ; 

[0028] ”所 述 惯性 导航 模块 根据 接收 到 的 惯性 测量 组 合 提供 的 惯性 测量 数据 完成 惯性 导 
航 计 算 ,得 到 发 射 惯性 坐标 系 下 运载 工具 的 速度 和 位 置 ; 
[0029] ”所 述 组 合 导航 模块 根据 接收 到 的 惯性 导航 模块 提供 的 位 置 和 速度 信息 以 及 卫星 
导航 接收 机 提供 的 位 置 和 速度 信息 进行 组 合 导航 计算 ,得 到 组 合 导航 的 位 置 和 速度 输出 
值 。 

[0030] ”进一步 地 ,所 述 惯性 导航 模块 进行 惯性 导航 计算 的 具体 过 程 为 : 

[0031] ”利用 惯性 测量 组 合 中 的 陀螺 仪 和 加 速度 计 的 脉冲 数 输出 ,通过 提取 增 量 信息 并 进 
行 系数 转换 ,计算 得 到 运载 工具 运动 的 角度 增 量 和 视 速度 增 量 ; 
[0032] ”利用 运载 工具 运动 的 角度 增 量 进行 四 元 数 更 新 计算 ,并 利用 更 新 后 的 四 元 数 计算 
惯 组 测量 坐标 系 到 发 射 惯性 坐标 系 的 旋转 矩阵 ; 
[0033] ”其 中 ,更 新 的 四 元 数 初 值 由 射 前 流程 结束 时 刻 惯 组 测量 坐标 系 和 发 射 坐 标 系 的 旋 
转 矩 阵 所 确定 ; 
[0034] “利用 惯 组 测量 坐标 系 到 发 射 惯 性 坐标 系 的 旋转 矩阵 ,将 惯 组 测量 坐标 系 下 的 视 速 
度 增 量 转换 至 发 射 惯性 坐标 系 下 ,得 到 发 射 惯性 坐标 系 下 的 视 速度 增 量 ; 
[0035] ”根据 发 射 惯性 坐标 系 下 的 视 速度 增 量 , 结 合 当 前 位 置 的 引力 矢量 进行 一 个 导航 周 
期 内 的 一 次 积分 和 两 次 积分 ,分 别 得 到 发 射 惯性 坐标 系 下 运载 工具 的 速度 和 位 置 。 

[0036] ”进一步 地 ,所 述 组 合 导航 模块 进行 组 合 导航 计算 的 过 程 为 : 

[0037] ”将 运载 工具 的 位 置 与 位 置 真 实 值 的 误差 的 估计 值 以 及 速度 与 速度 真实 值 的 误差 
的 估计 值 作为 状态 量 ;将 卫星 导航 接收 机 的 位 置 与 通过 惯 性 导航 计算 得 到 的 运载 工具 的 位 
置 真 实 值 的 误差 的 估计 和 值 ,以 及 卫星 导航 接收 机 的 速度 与 通过 惯性 导航 计算 得 到 的 运载 工 
具 的 速度 真实 值 的 误差 的 估计 值 作 为 观测 量 ; 
[0038] ”给 定 状态 量 的 初 值 ` 误 差 方差 阵 的 初 值 和 系统 噪声 方差 阵 的 初 值 ,以 及 量 测 噪 
方差 阵 和 观测 矩阵 ; 
[0039] ”根据 当前 导航 周期 惯性 导航 解 算 的 旋转 和 矩阵、 位 置 和 视 加 速度 信息 构造 当前 导航 
周期 的 状态 转移 矩阵 和 噪声 分 配 阵 ;其 中 ,利用 状态 转移 矩阵 构造 出 当前 导航 周期 一 步 状 
态 转 移 和 矩阵 ;使 用 状态 转移 矩阵 、 品 声 分 配 阵 和 系统 噪声 方差 阵 初 值 计算 得 到 当前 导航 周 
期 的 系统 噪声 方差 阵 ; 
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[0040] ”根据 计算 和 给 定 的 量 测 噪声 方差 阵 、 观 测 和 矩阵 、 旋 转 和 矩阵 、 状 态 转移 和 矩阵、 噪声 分 
配 阵 和 系统 噪声 方差 阵 以 及 状态 量 和 观测 量 ,利用 卡尔 曼 滤 波 公式 进行 状态 量 的 估计 和 修 
正 计 算 ; 
[0041] ”利用 当前 导航 周期 的 状态 量 的 估计 值 中 的 位 置 误差 对 惯性 导航 位 置 进行 修正 , 利 


用 当前 导航 周期 的 状态 量 的 估计 值 中 的 速度 误差 对 惯性 导航 速度 进行 修正 ,得 到 组 合 导航 
的 位 置 和 速度 输出 值 。 

[0042] “根据 本 申请 实施 例 的 第 二 方面 ,本 申请 还 提供 了 一 种 运载 火箭 组 合 导航 功能 验证 
方法 ,其 包括 以 下 步 又 ; 

[0043] ”使 运载 工具 和 惯性 测量 组 合 保持 静止 ,获取 惯性 测量 组 合 的 初始 方位 角 , 并 发 送 
给 飞 控 计算 机 ; 


[0044] ”惯性 测量 组 合 获取 运载 工具 的 惯性 测量 数据 并 发 送 给 飞 控 计 算 机 ; 

[0045] ” 飞 控 计算 机 中 的 射 前 流程 模块 根据 惯性 测量 组 合 的 初始 方位 角 和 运载 工具 的 惯 
性 测量 数据 计算 补偿 后 的 方位 角 和 惯性 测量 组 合 的 水 平 姿态 角 , 并 利用 补偿 后 的 方位 角 和 
惯性 测量 组 合 的 水 平 姿态 角 对 飞 控 计算 机 3 中 的 惯性 导航 模块 进行 初始 化 ; 

[0046] ”初始 化 后 的 惯性 导航 模块 利用 惯性 测量 数据 进行 惯性 导航 计算 ,得 到 惯性 导航 位 
置 和 速度 信息 ; 

[0047] ”卫星 导航 接收 机 将 其 当前 的 位 置 和 速度 信息 发 送 给 飞 控 计 算 机 ，; 

[0048] ” 飞 控 计算 机 中 的 组 合 导航 模块 利用 卫星 导航 接收 机 当前 的 位 置 和 速度 信息 以 及 
惯性 导航 位 置 和 速度 信息 进行 组 合 导航 计算 ,得 到 修正 后 的 位 置 和 速度 信息 ; 

[0049] ”启动 运载 工具 ,并 沿 预定 路 线 行驶 , 飞 控 计算 机 在 运载 工具 行驶 的 过 程 中 ,进行 全 
程 惯 性 导航 和 组 合 导航 计算 ,得 到 实验 数据 ; 

[L0050] ” 飞 控 计 算 机 通过 仿真 下 位 机 将 得 到 的 实验 数据 发 送 给 仿真 上 位 机 进行 存储 。 
[0051] “上 述 运载 火箭 组 合 导航 功能 验证 方法 中 ,获取 惯性 测量 组 合 的 初始 方位 角 时 , 根 
据 北 向 方位 和 由 电子 经 纬 仪 所 传递 的 瞄准 路 线 的 多 个 角度 得 到 惯性 测量 组 合 的 初始 方位 
角 ; 
[0052] ”所 述 北 向 方位 由 设置 在 地 面 上 的 陀螺 寻 北 仪 得 到 ,瞄准 路 线 的 多 个 角度 由 设置 在 
地 面 上 的 电子 经 纬 仪 得 到 。 
[0053] ”上述 运载 火箭 组 合 导航 功能 验证 方法 中 ,获取 惯性 测量 组 合 的 初始 方位 角 时 , 根 
据 地 球 重 力 加 速度 和 地 球 转角 速度 得 到 惯性 测量 组 合 的 初始 方位 角 ; 
[0054] ”所 述 地 球 重力 加 速度 和 地 球 转角 速度 由 惯性 测量 组 合 测量 得 到 。 

[0055] ”根据 本 申请 的 上 述 具 体 实施 方式 可 知 ,至 少 具有 以 下 有 益 效 果 : 本 申请 使 用 轿车 、 
跪 车、 飞机、 无 人 机 、 船 舶 等 运载 工具 进行 运载 火箭 组 合 导航 功能 验证 ,将 惯性 测量 组 合 、 卫 
星 接 收 机 、 飞 控 计算 机 和 仿真 平台 放置 在 运载 工具 中 ,完成 包括 初始 瞄准 、 惯 性 导航 和 卫星 
导航 数据 的 组 合 导航 计算 、 数 据 存储 的 全 套 导航 系统 实验 ,实现 对 火箭 导航 软 硬 件 全 系统 
和 全 流程 的 验证 ,能 够 确保 最 终 飞行 产品 的 可 靠 性 。 

[L0056] ”本 申请 可 以 对 运载 火箭 中 导航 系统 所 有 器 件 、 算 法 和 软件 实现 的 功能 进行 全 系统 
的 验证 ,克服 了 传统 导航 系统 仿真 实验 只 能 对 上 述 部 分 组 成 进行 验证 的 缺陷 ,减少 了 设备 、 
软件 间 不 匹配 的 风险 。 

[0057] ”本 申请 可 以 对 运载 火 第 的 射 前 、 组 合 导航 过 程 进行 全 流程 的 验证 ,减少 了 流程 间 
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不 协调 的 风险 ;减少 了 转台 、 离 心机 、 卫 星 模 拟 器 等 设备 的 使 用 ,节约 了 科研 成 本 ,减少 了 多 
设备 使 用 时 的 技术 故障 风险 以 及 模拟 效果 不 协调 和 不 真实 的 问题 ;实验 方案 简单 ,使 得 操 
作 人 员 可 快速 掌握 和 完成 实验 ,减少 了 和 人力 成 本 ,并 加 快 了 火 第 研发 的 进度 。 

L0058] ”应 了 解 的 是 ,上 述 一 般 描述 及 以 下 具体 实施 方式 仪 为 示例 性 及 阐释 性 的 ,其 并 不 
能 限制 本 申请 所 欲 主 张 的 范围 。 


附 图 说 明 

[0059] ”下 面 的 所 附 附 图 是 本 申请 的 说 明 书 的 一 部 分 ,其 示 出 了 本 申请 的 实施 例 ,所 附 附 
图 与 说 明 书 的 描述 一 起 用 来 说 明 本 申请 的 原理 。 
[0060] ”图 1 为 本 申请 实施 例 提供 的 一 种 运载 火箭 组 合 导航 功能 验证 系统 的 结构 示意 图 。 
[0061] ”图 2 为 本 申请 实施 例 提供 的 一 种 运载 火箭 组 合 导航 功能 验证 系统 的 信号 流 图 。 
[0062] ”图 3 为 本 申请 实施 例 提供 的 一 种 利用 运载 火箭 组 合 导航 功能 验证 方法 进行 验证 的 
流程 图 。 
[0063] ” 附 图 说 明 ; 

[0064] 1、 卫星 导航 接收 机 ;11、 接 收 机 天 线 ;12、 接 收 机 板 卡 ;2、 惯 性 测量 组 合 ;3、 飞 控 计 
算 机 ;4、 仿 真 下 位 机 ;5、 仿 真 上 位 机 ;6、 运 载 工 具 ;7、 陀 螺 寻 北 仪 ;8、 电 子 经 纬 仪 ;9、AD/DC 转 
换 器 。 


具体 实施 方式 

L0065] ”为 使 本 申请 实施 例 的 目的 、 技 术 方 案 和 优点 更 加 清楚 明白 ,下 面 将 以 附 图 及 详细 
叙述 清楚 说 明 本 申请 所 揭示 内 容 的 精神 ,任何 所 属 技术 领域 技术 人 员 在 了 解 本 申请 内 容 的 
实施 例 后 , 当 可 由 本 申请 内 容 所 教 示 的 技术 ,加 以 改变 及 修饰 ,其 并 不 脱离 本 申请 内 容 的 精 
神 与 范围 。 

[0066] ”本 申请 的 示意 性 实施 例 及 其 说 明 用 于 解释 本 申请 ,但 并 不 作为 对 本 申请 的 限定 。 
另外 ,在 附 图 及 实施 方式 中 所 使 用 相同 或 类 似 标号 的 元 件 / 构 件 是 用 来 代表 相同 或 类 似 部 
分 。 

[0067] ”关于 本 文中 所 使 用 的 “第 一 “第 二 ”… 等 ,并 非特 别 指称 次 序 或 顺 位 的 意思 ,也 
非 用 以 限定 本 申请 ,其 仅 为 了 区 别 以 相同 技术 用 语 描述 的 元 件 或 操作 。 

[0068] ”关于 本 文中 所 使 用 的 方向 用 语 , 例 如 :上 、 下 、 左 、 右 、 前 或 后 等 , 仅 是 参考 附 图 的 方 
向 。 因 此 ,使 用 的 方向 用 语 是 用 来 说 明 并 非 用 来 限制 本 创作 。 

L0069] ”关于 本 文中 所 使 用 的 “包含 "、“ 包 括 ”、“ 具 有 ”、“ 含 有 ”等 等 , 均 为 开放 性 的 用 语 , 即 
意 指 包含 但 不 限于 。 
L0070] ”关于 本 文中 所 使 用 的 “及 /或 ,包括 所 述 事物 的 任 一 或 全 部 组 合 。 

[0071] ”关于 本 文中 的 “多 个 "包括 “两 个 及 两 个 以 上 ;关于 本 文中 的 “多 组 "包括 “两 组 ” 
及 “两 组 以 上 ”。 

L0072] ”关于 本 文中 所 使 用 的 用 语 “ 大 致 "、“ 约 ”等 ,用 以 修饰 任何 可 以 细微 变化 的 数量 或 
误差 ,但 这 些微 变化 或 误差 并 不 会 改变 其 本 质 ,一 般 而 言 , 此 类 用 语 所 修饰 的 细微 变化 或 误 
差 的 范围 在 部 分 实施 例 中 可 为 20% ,在 部 分 实施 例 中 可 为 10% ,在 部 分 实施 例 中 可 为 5% 或 
是 其 他 数值 。 本 领域 技术 人 员 应 当 了 解 ,前 述 提 及 的 数值 可 依 实际 需求 而 调整 ,并 不 以 此 为 
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限 。 

[0073]  ” 某 些 用 以 描述 本 申请 的 用 词 将 于 下 或 在 此 说 明 书 的 别处 讨论 ,以 提供 本 领域 技术 
人 员 在 有 关 本 申请 的 描述 上 额外 的 引导 。 

[0074] ”如 图 1 所 示 , 本 申请 运载 火箭 组 合 导航 功能 验证 系统 包括 卫星 导航 接收 机 1、 惯 性 
测量 组 合 2、 飞 控 计算 机 3、 仿 真 下 位 机 4、 仿 真 上 位 机 5 和 运载 工具 6。 其 中 ,卫星 导航 接收 机 1 
设置 在 运载 工具 6 上 ,其 用 于 接收 卫星 信号 ,并 根据 卫星 信号 得 到 卫星 导航 接收 机 1 当前 的 
位 置 和 速度 数据 。 

[0075] ”惯性 测量 组 合 2 设置 在 运载 工具 6 内 ,其 用 于 获取 运载 工具 6 的 惯性 测量 数据 。 其 
中 ,惯性 测量 数据 包括 陀螺 仪 和 加 速度 计 的 脉冲 数 输出 。 

[0076]  ” 飞 控 计算 机 3 设置 在 运载 工具 6 内 ,其 与 卫星 导航 接收 机 1 和 惯性 测量 组 合 2 连接 ， 
用 于 根据 卫星 导航 接收 机 1 当前 的 位 置 和 速度 数据 以 及 惯性 测量 数据 计算 得 到 实验 数据 。 
在 初始 对 准 流程 中 ,实验 数据 包括 补偿 后 的 方位 角 、 水 平 姿态 角 ; 在 初始 对 准 流程 完成 后 ， 
实验 数据 包括 惯性 导航 计算 得 到 的 车 辆 运行 的 速度 .位 置 和 姿态 角 以 及 经 过 组 合 导航 修正 
后 的 车 辆 运行 的 速度 和 位 置 。 

[0077] ”仿真 下 位 机 4 和 仿真 上 位 机 5 均 设 置 在 运载 工具 6 内 ,仿真 下 位 机 4 与 飞 控 计算 机 3 
连接 ,其 用 于 启动 飞 控 计算 机 3 ,并 从 飞 控 计 算 机 3 处 获取 实验 数据 。 仿 真 上 位 机 5 与 仿真 下 
位 机 4 连接 ,其 用 于 提供 人 机 交互 界面 ,控制 仿真 下 位 机 4 的 启 停 ,并 从 仿真 下 位 机 4 处 获取 
实验 数据 。 

[0078] ”具体 地 ,卫星 导航 接收 机 1 包括 接收 机 天 线 11 和 接收 机 板 卡 12 ,接收 机 天 线 11 设 置 
在 运载 工具 6 的 顶部 ,接收 机 板 卡 12 设 置 在 运载 工具 6 内 ,接收 机 天 线 11 与 接收 机 板 卡 12 连 
接 。 接 收 机 天 线 11 将 接收 到 的 卫星 信号 发 送 给 接收 机 板 卡 12, 接 收 机 板 卡 12 根 据 卫 星 信 号 
计算 得 到 卫星 导航 接收 机 1 的 位 置 和 速度 信息 ,并 发 送 给 飞 控 计算 机 3。 

[0079] ”在 本 实施 例 中 ,运载 工具 6 可 以 为 车 辆 .船舶 和 飞机 等 交通 工具 。 本 申请 利用 车 辆 、 
船舶 和 飞机 等 容易 实现 的 交通 工具 代替 真实 运载 火箭 的 运动 ,实现 对 运载 火箭 空间 位 置 和 
姿态 运动 的 模拟 ;本 申请 使 用 容易 实现 的 交通 工具 代替 传统 仿真 中 使 用 的 转台 、 离 心机 、 卫 
星 模拟 器 ,实现 惯性 测量 组 合 2 和 卫星 接收 机 同步 进行 空间 位 置 和 姿态 运动 的 模拟 ,获得 组 
合 导 航 必 需 的 惯性 测量 组 合 2 和 卫星 信号 数据 。 

[0080] ”在 本 实施 例 中 ,本 申请 运载 火箭 组 合 导航 功能 验证 系统 还 包括 陀螺 寻 北 仪 7 和 电 
子 经 纬 仪 8; 其 中 ,陀螺 寻 北 仪 7 和 电子 经 纬 仪 8 均 设 置 在 地 面 上 ,陀螺 寻 北 仪 7 用 于 确定 北向 
方位 ,电子 经 纬 仪 8 用 于 测量 陀螺 寻 北 仪 7 和 惯性 测量 组 合 2 间 瞄准 路 线 的 多 个 角度 ;电子 经 
纬 仪 8 根据 北向 方位 角 和 瞄准 路 线 的 多 个 角度 确定 惯性 测量 组 合 2 的 初始 方位 角 , 并 通过 人 
工读 数 和 写 入 的 方式 将 惯性 测量 组 合 2 的 初始 方位 角 写 入 到 飞 控 计 算 机 3 中 。 

[0081] ”在 本 实施 例 中 ,本 申请 运载 火箭 组 合 导航 功能 验证 系统 还 包括 市 电 以 及 与 市 电 连 
接 的 AD/DC 转 换 器 9, 市 电 用 于 给 仿真 下 位 机 4 和 仿真 上 位 机 5 供电 ,AD/DC 转 换 器 9 与 飞 控 计 
算 机 3 和 惯性 测量 组 合 2 电 连 接 , 其 用 于 将 交流 电 转 换 成 直流 电 并 提供 给 飞 控 计算 机 3 和 惯 
性 测量 组 合 2。 

[0082] 例如 ,市 电 采 用 220V 交 流 电 ,AD/DC 转 换 器 9 将 220V 交 流 电 转 换 成 28V 和 5V 的 直流 
电 。28V 和 5V 的 直流 电 通 过 供电 电线 为 飞 控 计算 机 3 中 不 同 功 能 的 电路 供电 ,28V 直 流 电 还 为 
惯性 测量 组 合 2 供 电 。 
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[0083] ”在 本 实施 例 中 ,本 申请 运载 火箭 组 合 导航 功能 验证 系统 还 包括 耦合 器 ,仿真 下 位 
机 4、 飞 控 计 算 机 3 和 惯性 测量 a nn 以 便于 仿真 下 位 机 4 
向 飞 控 计 算 机 3 发 送 控制 指令 、 飞 控 计 算 机 3 计算 得 到 的 实验 数据 发 送 给 下 位 机 ,以 及 惯性 
测量 组 合 2 将 惯性 测量 数据 发 送 给 飞 控 计 算 机 3。 

[0084] ”具体 地 , 飞 控 计算 机 3 中 设置 有 射 前 流程 模块 、 惯 性 导航 模块 和 组 合 导航 模块 。 
[0085] ”其 中 , 射 前 流程 模块 根据 接收 到 的 初始 方位 角 和 惯性 测量 数据 计算 补偿 后 的 方位 
角 和 惯性 测量 组 合 2 的 水 平 姿态 角 。 利 用 补偿 后 的 方位 角 和 惯性 测量 组 合 2 的 水 平 姿态 角 对 
惯性 导航 模块 进行 初始 化 。 

[0086] 惯 se all os 性 测量 组 合 2 提供 的 惯性 测量 数据 完成 惯性 导航 计 


师 


[0087] ”SS1 利用 惯 性 测量 组 合 2 中 的 陀螺 仪 和 加 速度 计 的 脉冲 数 输出 ,通过 提取 增 量 信息 
并 进行 系数 转换 ,计算 得 到 运载 工具 6 运动 的 角度 增 量 和 视 速 度 增 量 。 
[0088] ”S2、 利 用 运载 工具 6 运动 的 角度 增 量 进行 四 元 数 更 新 计算 ,并 利用 更 新 后 的 四 元 数 
计算 惯 组 测量 坐标 系 到 发 射 惯性 坐标 系 的 旋转 矩阵。 
[0089] ”其 中 ,更 新 的 四 元 数 初 值 由 射 前 流程 结束 时 刻 惯 组 测量 坐标 系 和 发 射 坐 标 系 的 旋 
转 和 矩阵 所 确定 。 
[0090] ”SsS3、 利 用 惯 组 测量 坐标 系 到 发 射 惯 性 坐标 系 的 旋转 矩阵 ,将 惯 组 测量 坐标 系 下 的 
视 速 度 增 量 转换 至 发 射 惯性 坐标 系 下 ,得 到 发 射 惯性 坐标 系 下 的 视 速 度 增 量 。 

[0091] ”SS4、 根 据 发 射 惯性 坐标 系 下 的 视 速 度 增 量 ,结合 当前 位 置 的 引力 矢量 进行 一 个 导 
航 周 期 内 的 一 次 积分 和 两 次 积分 ,分 别 得 到 发 射 惯性 坐标 系 下 运载 工具 6 的 速度 和 位 置 。 
[0092] “组合 导航 模块 根据 接收 到 的 惯性 导航 模块 提供 的 位 置 和 速度 信息 以 及 卫星 导航 
接收 机 1 提供 的 位 置 和 速度 信息 进行 组 合 导航 计算 ,其 具体 计算 过 程 为 : 

[0093] ”Sl1、 将 运载 工具 6 的 位 置 与 位 置 真 实 值 的 误差 的 估计 值 以 及 速度 与 速度 真实 值 的 
误差 的 估计 值 作为 状态 量 ;将 卫星 导航 接收 机 1 的 位 置 与 通过 惯 性 导航 计算 得 到 的 运载 工 
具 6 的 位 置 真 实 值 的 误差 的 估计 值 ,以 及 卫星 导航 接收 机 1 的 速度 与 通过 惯性 导航 计算 得 到 
的 运载 工具 6 的 速度 真实 值 的 误差 的 估计 值 作为 观测 量 。 
[0094] ”S2 给 定 状 态 量 的 初 值 、. 误 差 方差 阵 的 初 值 和 系统 噪声 方差 阵 的 初 值 , 以 及 量 测 噪 
声 方差 阵 和 观测 矩阵 。 
[0095] ”S$S3、 根 据 当前 导航 周期 惯性 导航 解 算 的 旋转 矩阵 、 位 置 和 视 加 速度 信息 构造 当前 
导航 周期 的 状态 转移 矩阵 和 噪声 分 配 阵 ; 其 中 ,状态 转移 矩阵 可 以 构造 出 当前 导航 周期 一 
步 状态 转移 矩阵 ;而 使 用 状态 转移 矩阵 、 噪 声 分 配 阵 和 系统 噪声 方差 阵 初 值 可 以 计算 当前 
导航 周期 的 系统 噪声 方差 阵 。 
[0096] “”S4、 根 据 $1 一 S4 中 计算 和 给 定 的 量 测 噪声 方差 阵 、 观 测 矩 阵 、 旋 转 矩 阵 、 状 态 转移 
矩阵、 噪声 分 配 阵 和 系统 噪声 方差 阵 以 及 状态 量 和 观测 量 ,利用 卡尔 曼 滤 波 公式 进行 状态 
量 的 估计 和 修正 计算 。 

[0097] ”SsS5、 利 用 当前 导航 周期 的 状态 量 的 估计 值 中 的 位 置 误差 对 惯性 导航 位 置 进行 修 
正 ,利用 当前 导航 周期 的 状态 量 的 估计 值 中 的 速度 误差 对 惯性 导航 速度 进行 修正 ,得 到 组 
合 导 航 的 位 置 和 速度 输出 值 。 

[0098] ”仿真 上 位 机 5 中 设置 有 仿真 控制 和 数据 存储 软件 。 仿 真 上 位 机 5 将 编译 后 的 仿真 控 
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制 和 数据 存储 软件 加 载 到 仿真 下 位 机 4 中 ,实现 控制 整个 实验 流程 .提供 人 机 交互 界面 、 完 
成 数据 存储 的 功能 。 
[0099] ”与 传统 的 导航 系统 仿真 实验 相 比 ,本 申请 对 运载 火箭 中 导航 系统 所 有 器 件 、 算 法 
和 软件 实现 的 功能 进行 全 系统 的 验证 ,能 够 克服 传统 导航 系统 仿真 实验 只 能 对 上 述 部 分 组 
成 进行 验证 的 缺陷 ,减少 设备 、 软 件 间 不 匹配 的 风险 。 

L0100] ”本 申请 能 够 对 运载 火箭 的 射 前 ` 组 合 导 航 过 程 进行 全 流程 的 验证 ,从 而 减少 流程 
间 不 协调 的 风险 。 
L0101] ”本 申请 减少 了 转台 、 离 心机 、 卫 星 模 拟 器 等 设备 的 使 用 ,能 够 节约 科研 成 本 ,减少 
多 设备 使 用 时 的 技术 故障 风险 。 

[0102] ”本 申请 采用 的 实验 方案 简单 ,操作 人 员 能 够 快速 掌握 和 完成 实验 ,减少 人 力 成 本 
并 加 快 火箭 研发 的 进度 。 
[0103] “基于 以 上 运载 火箭 组 合 导 航 功 能 验证 系统 ,本 申请 还 提供 了 一 种 运载 火箭 组 合 导 
航 功能 验证 方法 ,其 包括 以 下 步骤 ， 
[0104] ”S1、 使 运载 工具 6 和 惯性 测量 组 合 2 保 持 静 止 ,获取 惯性 测量 组 合 2 的 初始 方位 角 ， 
并 发 送 给 飞 控 计算 机 3。 

L0105] ”S2、 惯 性 测量 组 合 2 获取 运载 工具 6 的 惯性 测量 数据 并 发 送 给 飞 控 计 算 机 3。 
L0106]  S3、 飞 控 计 算 机 3 中 的 射 前 流程 模块 根据 惯性 测量 组 合 2 的 初始 方位 角 和 运载 工具 
6 的 惯性 测量 数据 计算 补偿 后 的 方位 角 和 惯性 测量 组 合 2 的 水 平 姿态 角 , 并 利用 补偿 后 的 方 
位 角 和 惯性 测量 组 合 2 的 水 平 姿态 角 对 飞 控 计算 机 3 中 的 惯性 导航 模块 进行 初始 化 。 

[0107] ”SsS4、 初 始 化 后 的 惯性 导航 模块 利用 惯性 测量 数据 进行 惯性 导航 计算 ,得 到 惯性 导 
航 位 置 和 速度 信息 。 

L0108] ”Ss5、 卫 星 导航 接收 机 1 将 其 当前 的 位 置 和 速度 信息 发 送 给 飞 控 计算 机 3。 

[0109] ”Ss6、 飞 控 计算 机 3 中 的 组 合 导 航模 块 利用 卫星 导航 接收 机 1 当前 的 位 置 和 速度 信息 
以 及 惯性 导航 位 置 和 速度 信息 进行 组 合 导航 计算 ,得 到 修正 后 的 位 置 和 速度 信息 ,该 位 置 
和 速度 即 组 合 导航 功能 所 实现 的 对 运载 工具 6 运动 信息 的 最 优 估计 ,并 作为 实验 数据 进行 
L0110] ”SS7、 运 载 工具 6 启动 ,并 沿 预 定 路 线 行驶 , 飞 控 计算 机 3 在 运载 工具 6 行驶 的 过 程 中 ， 
进行 全 程 惯 性 导航 和 组 合 导 航 计 算 , 得 到 实验 数据 其中, 预定 路 线 的 周围 开阔 ,遮挡 少 ,能 
够 获得 清晰 完整 的 卫星 导航 信号 。 

L0111] ” S8、 飞 控 计算 机 3 通过 仿真 下 位 机 4 将 得 到 的 实验 数据 发 送 给 仿真 上 位 机 5 进行 存 
储 。 

[0112] ”上述 步 又 $1 中 ,获取 惯性 测量 组 合 2 的 初始 方位 角 时 ,可 以 根据 北向 方位 和 由 电子 
经 纬 仪 8 所 传递 的 瞄准 路 线 的 多 个 角度 得 到 惯性 测量 组 合 2 的 初始 方位 角 。 其 中 ,北向 方位 
可 以 由 设置 在 地 面 上 的 陀螺 寻 北 仪 7 得 到 ,瞄准 路 线 的 多 个 角度 可 以 由 设置 在 地 面 上 的 电 
子 经 纬 仪 8 得 到 。 

[0113] “另外 ,获取 惯性 测量 组 合 2 的 初始 方位 角 时 ,还 可 以 根据 地 球 重力 加 速度 和 地 球 转 
角速度 得 到 惯性 测量 组 合 2 的 初始 方位 角 。 其 中 ,地 球 重力 加 速度 和 地 球 转角 速度 由 惯性 测 
量 组 合 2 测 量 得 到 。 

L0114] ”如 图 3 所 示 , 当 运载 工具 使 用 跑车 时 ,可 以 根据 图 3 所 示 的 实验 流程 进行 基于 跑车 
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的 组 合 导航 仿真 实验 ,其 具体 过 程 为 : 

[0115] (1) 将 车 辆 停放 于 平地 上 ,将 所 有 需要 车 载 的 设备 都 放置 于 车 上 并 连接 线 绕 ,将 惯 
性 测量 组 合 平 放 且 与 车 辆 固定 。 
[0116] ”(2) 不 移动 车 辆 和 惯性 测量 组 合 的 位 置 , 使 用 陀螺 寻 北 仪 和 电子 经 纬 仪 找 出 当前 
惯性 测量 组 合 的 初始 方位 角 , 并 将 该 初始 方位 角 人 工装 订 到 射 前 流程 模块 中 。 

[0117] (3) 给 仿真 下 位 机 和 直流 电源 供电 ,直流 电源 再 给 惯性 测量 组 合 和 飞 控 计 算 机 供 
电 。 

[0118] ” (4) 打开 仿真 上 位 机 和 仿真 下 位 机 ,通过 人 机 交互 界面 将 仿真 控制 和 数据 存储 软 
件 加 载 到 仿真 下 位 机 中 并 启动 。 
[0119] (5) 仿真 控制 软件 自动 完成 对 飞 控 计 算 机 的 上 电 和 箭 地 握手 控制 ,从 而 启动 飞 控 
计算 机 。 

[0120] (6) 飞 控 计算 机 利用 初始 方位 角 和 惯性 测量 数据 计算 补偿 后 的 方位 角 和 惯性 测量 
组 合 的 水 平 姿 态 角 , 并 利用 补偿 后 的 方位 角 和 惯性 测量 组 合 的 水 平 姿态 角 对 飞 控 计算 机 中 
的 惯性 导航 模块 进行 初始 化 。 

[0121] (7) 飞 控 计算 机 启动 后 ,接收 机 板 卡 根据 接收 机 天 线 的 卫星 信号 计算 得 到 当前 车 
辆 WGS84 坐 标 系 下 的 位 置 和 速度 。 

[0122] (8) 飞 控 计算 机 使 用 惯性 测量 数据 进行 惯性 导航 计算 ,得 到 惯性 导航 位 置 和 速度 
[0123] (9) 飞 控 计算 机 将 来 自卫 星 导航 接收 机 的 位 置 和 速度 与 来 自 惯性 导航 的 位 置 和 速 
度 进行 组 合 导航 计算 ,得 到 修正 后 的 位 置 和 速度 信号 。 

[0124] (10) 进入 组 合 导 航 修正 流程 后 ,车 辆 启动 , 沿 着 预定 路 线 行驶 , 飞 控 计 算 机 在 此 过 
程 中 完成 全 程 的 惯性 导航 、 组 合 导航 计算 并 通过 1553B 发 送 数据 给 仿真 下 位 机 。 

[0125] (1D) 仿真 下 位 机 将 数据 通过 网 线 传输 给 仿真 上 位 机 ,由 仿真 上 位 机 存储 数据 。 
[0126] (12) 飞 控 计算 机 下 电 、 停 止 仿真 控制 和 数据 存储 软件 .关闭 仿真 下 位 机 和 直流 电 
源 、 撤 收 设 备 ,结束 实验 。 

[0127] (13) 对 数据 结果 进行 分 析 。 

[0128] ”在 示例 性 实施 例 中 ,本 申请 实施 例 还 提供 了 一 种 计算 机 存储 介质 ,是 计算 机 可 读 
存储 介质 ,例如 ,包括 计算 机 程序 的 存储 器 ,上 述 计算 机 程序 可 由 处 理 器 执行 ,以 完成 前 述 
运载 火箭 组 合 导 航 功 能 验证 方法 中 的 所 述 步 又 。 

[0129] ee 全 人 各 种 硬件 、 软 件 编码 或 两 者 组 合 中 进行 实施 .例如 ,本 申 


言 写 处 理 器 (Digital 2 Processor,DSP) 中 执行 上 述 方 
法 的 程序 代码 ,本 申请 也 可 涉及 计算 机 处 理 器 ,数字 信号 处 理 器 . 微 处 理 器 或 现场 可 纺 程 站 


阵列 (Field ee GateArray , FPGA) 0 bE ,可 根据 本 申请 配置 上 述 处 
理 器 执行 特定 任务 ,其 通过 执行 定义 了 本 申请 揭示 的 特定 方法 的 机 器 可 读 软 件 代码 或 固件 
代码 来 完成 ,可 将 软件 代码 或 固件 代码 发 展 表 示 不 同 的 程序 语言 与 不 同 的 格式 或 形式 。 也 
可 表示 不 同 的 目标 平台 编译 软件 代码 。 然 而 ,根据 本 申请 执行 任务 的 软件 代码 与 其 他 类 型 
配置 代码 的 不 同 代码 样式 、 类 型 与 语言 不 脱离 本 申请 的 精神 与 范围 。 

[0130] ”以 上 所 述 仅 表示 本 申请 示意 性 的 具体 实施 方式 ,在 不 脱离 本 申请 的 构思 和 原则 的 
前 提 下 ,任何 本 领域 的 技术 人 员 所 做 出 的 等 同 变化 与 修改 , 均 应 属于 本 申请 保护 的 范围 。 
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上 下 电 、 第 地 握手 指令。 飞 控 计 算 机 
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到 初始 方位 角 | 


装订 初始 方位 角 


加 载 和 启动 仿真 控 
制 和 数据 存储 软件 
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计算 补偿 后 方位 
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算 卫星 导航 数据 
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组 合 导航 计 
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车 辆 启动 并 沿 预定 路 线 行驶 


数据 存储 


数据 分 析 
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